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Abstract. A closed form equation for inverse kinematics of manipula- 
tor with redundancy is derived, using the Lagrangian multiplier method. 
The proposed equation is proved to provide the exact equilibrium state 
for the resolved motion method, and is shown to be a general expression 
that yields the extended Jacobian method. The repeatability problem in 
the resolved motion method does not exist in the proposed equation. The 
equation is demonstrated to give more accurate trajectories than the re- 
solved motion method. 
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1 Introduction 

A kinematically redundant robot manipulator is a manipulator that has 
more degrees of freedom than are necessary to locate the end effector at a 
desired position and orientation. For example, if we want to locate some 
point on a two-dimensional end effector at a specified position and ori- 
entation, we need three degrees of freedom. Thus, a robot manipulator 
with more than three degrees of freedom is kinematically redundant in the 
two-dimensional space. 

The major advantages to adding redundant degrees of freedom to a 
robot manipulator are as follows: 

1. One achieves greater dexterity in maneuvering in a workspace with 
obstacles. 

2. One can avoid singular configurations of the manipulators. 

/"> 1.1 The Resolved Motion Method vs. the Inverse 

Kinematic Method 

Because of these significant advantages, an increasing amount of research 
has focused on the kinematically redundant manipulator, and the progress 
in this field has been rapid [Whitney,1972; Liegeois,1977; Klein and Huang,1983; 
Yoshikawa,1984; Hollerbach.,1984]. Much of this research has involved the 
resolution of motion using the pseudoinverse of the Jacobian matrix — also 
known as the Moore-Penrose generalized inverse matrix — in order to re- 
solve the redundancy. This resolved motion technique first determines the 
joint velocity using the pseudoinverse matrix, and then incrementally de- 
termines the joint displacement; it thus transforms from workspace to joint 
space via joint velocity. In contrast to this direction of research, relatively 
little research [Benati et al,1982; Hollerbach.,1984] has involved the inverse 
kinematics — the direct mapping from the workspace to the joint space — 
for kinematically redundant manipulators. 

The advantages and disadvantages in the inverse kinematic method over 
the resolved motion method are well known in nonredundant robot manip- 
ulators. The resolved motion method — now using the inverse of the Jaco- 
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bian matrix instead of the pseudoinverse matrix — is well-defined for gen- 
eral manipulator kinematics, except for numerical problems near kinematic 
singularities. Furthermore, the joint velocities can be efficiently computed 
from the workspace velocities using the Jacobian matrix without requiring 
an explicit matrix inverse. The resolved motion method, however, has some 
weak points: 

• The method has intrinsic inaccuracy because of linear approximation 
characteristics of the Jacobian matrix; thus it accumulates errors, 
which become even larger as the velocity increases. 

• The method does not give directly the joint values for a given position 
and orientation of the end effector. 

On the other hand, the inverse kinematic method has symbolic solutions 
only in some types of manipulator kinematics [Pieper,1969]. For general 
manipulator kinematics, it has only iterative solutions based on numerical 
methods, which can be computationally expensive unless we have initial 
conditions sufficiently near to the solution. However, this method — be it 
symbolic or numerical — is attractive because of the direct mapping from 
the workspace to joint space, fixing most of the aforementioned problems 
of the resolved motion method. 

1.2 Inverse Kinematic Method in the Redundant 
Manipulator 

The comparison between the two methods remains essentially unchanged 
in redundant robot manipulators; thus we have good reasons to choose the 
inverse kinematic method. 

As in the nonredundant case, no symbolic solution has been developed 
yet for the general redundant manipulator, for we cannot obtain symbolic 
solutions unless certain conditions are met by the manipulator structure. 
For example, in [Benati et al,1982; Hollerbach,1984] only some of the joint 
variables were obtained symbolically. To obtain these solutions the ma- 
nipulator structure and the number of degrees of freedom were fixed — 
explicitly in [Hollerbach,1984] and implicitly in [Benati et al,1982]. 
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An additional difficult task for a redundant manipulator — regardless 
of whether or not it has symbolic solutions — is to rationally (or optimally) 
use the extra degrees of freedom to achieve the objectives such as singularity 
avoidance or obstacle avoidance. In other words, the task is to resolve the 
redundancy while achieving some objectives. 

To our knowledge, the general, closed-form equation to resolve the re- 
dundancy at the inverse kinematic level has not appeared yet. In this 
paper, we propose a method, or a general equation — derived from the La- 
grangian multiplier method — to resolve the redundancy; thus fully spec- 
ifying the kinematic equations. The resulting system of equations will be 
qualitatively compared with the two existing methods: the extended Ja- 
cobian method[Baillieul,1985] and the resolved motion method [Liegeois 
,1977; Klein and Huang,1983], which uses the pseudoinverse matrix. From 
this comparison, the relationships between the proposed method and each 
of the two methods will be examined. To numerically evaluate the proposed 
method, the system of equations — which requires numerical iterative so- 
lutions — is solved for a simulated task, and its solutions are compared 
with those of the resolved motion method. 

In Section 2, the proposed method will be derived. In Section 3, the 
comparison and the relationships will be covered. The proposed method 
will be evaluated by simulations in Section 4, and the results will be dis- 
cussed in Section 5, and conclusions in Section 6. 

2 Derivation of the Proposed Equation 

In this section, we will derive extra equations which, together with the kine- 
matic equations of the manipulator, can fully specify the under-determined 
problem. 

The kinematic equation for the redundant manipulator is given as the 
following vector equation: 

x = f(0) (1) 

where x is an m-dimensional vector representing the position and orien- 

— * 

tation of the end effector in the workspace, is n-dimensional vector rep- 
resenting joint variables, and f is a vector function consisting of m scalar 
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functions, with m < n. Eq.(l) may be rewritten as 

F0 =f(*Vx (lo) 

Let H (0) be some criteria function to be minimized, which quantitatively 
represents the desired performance — for instance, singularity avoidance or 
obstacle avoidance. Here, any criteria function can be used, as long as the 
function is expressed in terms of joint variables — which is easy in most 
cases by using Eq.(l) — and the function has first partial derivatives. 
Let us define the Lagrangian function L(0) as the following: 

L{0) = X T F(9) + H{9) (2) 

— * 

where A is an m-dimensional Lagrangian multiplier vector. At the minimum 
ofX, 

ae ae ~ r a$ (3) 

/"""N =0 

where the m x n matrix, ^£, is the Jacobian matrix J. The second term in 
the r.h.s. of Eq.(3) may be expressed as 

d9 
where h = (h u h 2 , ..., h n ) T with 

dH ,. 
= ~d¥* ^ = 1,2, " ,n > 

Thus Eq.(3) becomes the following: 

A r J = -h T (4) 

If we transpose Eq.(4), we get 

J T A = -h 
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where (J*) r denotes the transpose of i-th column vector of the Jacobian 
matrix. If we select m linearly independent rows from 3 T , which are, with- 
out loss of the generality, the first m rows, and constitute a nonsingular 
matrix, J m , then A can be obtained from Eq.(5), as 



A: 
A 2 



. •*m 



= -J 



-1 



m 



hi 

hi 



Substituting this into Eq.(5), we have 






(J n ) T 

For simplicity, let us denote 

Jn- 



"m 
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m 



h r 



(J m + 2 ) T 
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h m +i 

h m +2 



h n . 



(J») 

where J n -m is an (rc — ra) x m matrix. If we define 

" ~ [«n-m«Jm : "~ In-mJ 



(6) 
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where I n _ m is an identity matrix of rank (n — m), then Eq.(6) becomes 

Zh = (7) 

where Z and h are defined as above. If we combine the kinematic equation, 
Eq.(l), with Eq.(7), as a system of equations, we get 



( 



X = f W (7a) 

Zh =0 K ' 



Since Z is an in — m) x n matrix, and h is an n-dimensional vector, 
Eq.(7) consists of (n—m) scalar equations with n unknowns, 6. On the other 
hand, the kinematic equation, Eq.(l), has m scalar equations. Therefore, 
Eq.(7a) has n independent nonlinear equations which now fully specify the 
n unknowns. Note that Eq.(7a) has to be solved numerically. 

The additional set of equations, Eq.(7), resolve the redundancy — at 
the inverse kinematic level — in such a way that the criteria function, 
H(0), may be minimized. This resolution of redundancy may be viewed as 
the direct counterpart of the resolution technique in the resolved motion 
method, which uses the null space to resolve the redundancy. We will 
discuss the relationship in more detail in the subsequent section. Note the 
generality of Eq.(7); no assumption was made that could limit it. 

3 Comparison with Other Methods 

In this section, the present result in Eq.(7) will be compared with two 
existing methods: the extended Jacobian method and the resolved motion 
method which uses the pseudoinverse. The relationships will be investigated 
on the basis of comparisons. 

3.1 Relationship with Extended Jacobian Method 

An alternative method to resolve the redundancy — also at the inverse 
kinematic level — is presented in [Baillieul,1985]. This method derives the 
additional equations by using the orthogonality between the gradient vector 
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of the criteria function and the null space vector, rij, such as 

G0) =njh (8) 

where 

n J = (A 1 ,A 2 ,..,A n ) r (9) 

with 

A,- = {-l) i+1 det{j\ J 2 ,.., J'- 1 , J i+1 ,.., J n ) (10) 

and where J k is the fc-th column vector of the Jacobian matrix. From 
the resulting fully specified system of equations, the new Jacobian matrix, 
called the extended Jacobian, is derived, just in the same way as in the 
nonredundant case. 

This method, however, is limited to redundant manipulators that have 
only one redundant degree of freedom, that is, only if n = m+1. Obviously, 
this limitation is not desirable. 

As proved in Appendix A, the additional equation, Eq.(8) can be also 
obtained from Eq.(7) in the case that n = m + 1. Therefore, we may regard 
Eq.(7) as a general equation from which Eq.(8) could be derived. 

Moreover, as Eqs.(9) and (10) show, elements of nj are the determi- 
nants of n m x m submatrices made from the original Jacobian matrix — 
making n different combinations from n column vectors, and obtaining n 
determinants. Compared to this, however, Eq.(7) has only one inversion of 
an m x m matrix; accordingly, it is somewhat easier to manipulate either 
symbolically or numerically. 

Therefore, we may say that Eq.(7) is the more general equation with 
expressions somewhat simpler to treat and more efficient to compute than 
Eq.(8). 

3.2 Relationship with Pseudoinverse Control 

A general solution for the equation 

x = 30, 
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when n> m, was given as [Ben-Israel and Greville,1980] 

9 = J + x + (I - J + J)h (11) 

where J + is the pseudoinverse matrix, defined as 

J + =J T (JJ r )- x (12) 

and (I — J + J) is the null space of J, with h an arbitrary vector. Eq.(ll) 
gives a way to resolve the redundancy at the velocity level. 

Liegeois[1977] developed a formulation of resolution of redundancy, such 
that a scalar criteria function may be minimized, by setting the vector h 
as 

h = V# (12a) 

where H is the criteria function to be minimized. He expresses Eq.(ll) and 
Eq.(12a) in terms of the infinitesimal displacement, as 

r^ d6 = J + dx+(I-J + J) y# (13) 

In Eq.(13)(or Eq.(ll)), the first term in the r.h.s. is responsible for the 
displacement of the end effector. The second term, on the other hand, 
forces joints to have self-motion to achieve an equilibrium (or optimum), 
$*, where H has a local minimum, for an instantaneous location of the end 
effector, x(i). In practice, however, while the joint variables are searching 
for a 0* for a given x, x(t) continuously varies — thus requiring different 
0*'s. Therefore, the joint variables never reach the optimal configuration, 
but are slightly different from that configuration in the direction determined 
by the first term in Eq.(13), J + dx. 

Because of these characteristics, the resolved motion method in Eq.(13)(or 
Eq.(ll)) has an undesirable property: it does not preserve repeatablity of 
joint values for repeated end effector motions. More specifically, two factors 
that cause this property are as follows: 

1. Because of the directionality in the first term of Eq.(13), the joint 
variables have different values depending on the direction of the re- 
peated path — a cyclic path, for instance — in the workspace. Note, 
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however, that the repeatablility can be preserved when tracing only 
one direction of the cyclic path even in the presence of this factor 
[Baillieul,1985]. 

2. Because of the irreversibility of the second term, they never return to 
the original configuration, once the joint variables achieve a $*. This 
situation can happen at the initial transient period when initial joint 
values are far from the optimum; for the optimal joint values cannot 
be known in advance. 

In Appendix B, we prove that Eq.(7) is the necessary and sufficient condi- 
tion to be satisfied when Eq.(13) reaches its equilibrium states with dx. = 0. 
In other words, Eq.(7a) gives the exact equilibrium state at which Eq.(13) 
will eventually arrive — the optimal joint configuration — for a given end 
effector location. Thus, we may regard Eq.(l3) in the resolved motion 
method as an approximated equation linearized at states that are exactly 
determined by Eq.(7a). 

4 Simulation 

In this section, we select a kinematically redundant manipulator and apply 
Eq.(7). The resulting system of equations are solved numerically for x, 
the end effector location, which makes a cyclic path. In parallel to using 
Eq.(7a), the resolved motion method is applied to the same manipulator 
with the same tip motion. The points we try to examine or verify through 
the simulation are as follows: 

1. Whether the resulting system in Eq.(7a) gives kinematically correct 
joint variables for a given x, achieving the performance represented 
by the criteria function we select. 

2. How the present method compares to the resolved motion method in 
terms of accuracy and repeatability. 

3. Whether the present method gives, in fact, the same equilibrium 
states as the resolved motion method will eventually reach. 
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Figure 1: The Schematic Diagram Of The Redundant Manipulator 
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We use the same manipulator presented in the paper[Yoshikawa,1984] 
for the sake of comparison of data obtained in that paper: a 3 degrees of 
freedom manipulator with the end effector moving in the (x,y) plane; thus 
kinematically redundant. The schematic diagram with necessary parame- 
ters is in Figure 1. 

The task is to make a square path — thus a cyclic path — while avoid- 
ing singularities. A good criteria function for this objective may be the 
manipulability[Yoshikawa,1984], which is given as 



H = det(33 T ) 



(14) 



The kinematic equation is given as 

X = l\Si + I2S12 + hsus (15) 

y = /xC! + l 2 c 12 + / 3 c 123 (16) 

where h,h, and / 3 represent the length of each link, while the variables with 
subscripts are denned as 



Si = sin(6i), Sij_ k = sin(0i + 3 - + ... + k ), 

Ci = cos(0i), Cij.., k = cos(0i + 0j + ... + k ), i,j, 



.,£ = 1,2,3 
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Then, the Jacobian matrix is obtained as 

J = 
where 



( vc 123 + UC 12 + Cx vc 123 + uc 12 vc 123 \ / 17 x 

\ - u,s 123 - US U + Sx -VS n3 ~ US 12 -VS 123 J 



l 2 *9 

U — —, V — 



By applying Eq.(7), we get 

2u 2 V S (s 23 S 33 - C23S3) + UV 3 (2s 23 S 23 s - 33223353) + 2tt S U 2 S2<S33+ 
W 2 V 2 (C33 - C22) + 2UV 2 (5 2 5 2 233 ~ C 2 sl s ) - U S VS 22 S S — 2u 2 VS 2 S S (18) 

= 

where the same definition is used for the subscripts as in Eqs.(15) and (16). 
The system of equations, Eq.(15), Eq.(16), andEq.(18) now fully specify 
the originally under-determined system of equations, Eq.(15) and Eq.(16), 
while minimizing H in Eq.(14). The system of equations may be solved 
either purely numerically, or by symbolically reducing variables — in this 
example, X — and then by using numerical methods. Incidentally, this 
example suggests that it is possible to reduce variables, thus reducing the 
order of the system of nonlinear equations, after resolving the redundancy 
first with all the joint variables. The system of equations were numerically 
solved for joint values, tracing each (x,y) on a square command path in 
the workspace by using a subroutine called ZSOLVE, translated from the 
IMSL library into MACSYMA. As shown in Figure 3, the x-y coordinates 
of the four vertices of the command path are given as follows: 

(446.00, 91.514),(546.00, 91.514) 

(446.00,-84.865), (546.00,-84.865), 

where the units are mm. 

Meanwhile, the resolved motion method in Eq.(ll) is also applied to 
this manipulator for the same path. Since Eq.(ll) is a system of differ- 
ential equations, a FORTRAN program, called DYSYS — which uses the 
Runge-Kutta integration method — was used together with the LINPACK 
subroutines. Note that this numerical scheme allows much more accurate 
solutions than the normal scheme for the resolved motion method. That 
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is, the Runge-Kutta method evaluates the derivative four times at each 
time interval and calculates the weighted average, while the normal scheme 
evaluates it only once at each time interval. 

The simulation for the resolved motion method was made with initial 
joint angle values of (-40.5006, 141.6408, 78.4169) in degrees, which are 
far from equilibrium states, that were deliberately selected to examine re- 
peatability. The same initial value was also used as the initial guess for the 
above nonlinear equations for fair comparison of the two methods. 

5 Results and Discussions 

5.1 Results 

The numerical results of simulations are listed in Figures 2-3 and Tables 
1-3: 

• Figure 2 is the plot of joint variables solved with the two methods. 
< / * Note that the 3-D trajectory of joint variables is represented with two 

2-D plots: #i vs. $2 an d #i vs - #3« 

On the other hand, Figure 3 shows actual trajectories, with the two 
methods, of the end effector in the workspace, as compared to the 
command path. The actual trajectory was determined by forward 
kinematics with joint values obtained by each method. 

• In Table 1, some representative solutions are listed to numerically 
compare the accuracy of the end effector position obtained with each 
method, while, in Table 2, the repeatability was examined for a simple 
reciprocal path. 

Table 3, on the other hand, verifies the relationship proved in Ap- 
pendix B : the solution with the resolved motion method when dx = 
is the same as that with the proposed method. 
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Figure 1: Joint Trajectories Obtained With The Two Methods 
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Figure 2: The Command Path And Actual Workspace Trajectories 
Obtained With The Two Methods 
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Table 1: The Comparison Of Accuracy Obtained With The Two 
Methods 



X(mm) Y(mm) 0i(deg) 2 (deg) 3 (deg) 



Command Path 
Proposed Method 
Resolved Method 



446.00 91.514 

446.00 91.514 -25.5116 134.4894 100.8165 

446.00 91.514 -40.5006 141.6408 78.4169 



Command Path 
Proposed Method 
Resolved Method 



446.00 -84.866 

446.00 -84.866 -13.4927 135.1801 101.6627 

445.74 -65.824 -14.0445 135.3160 101.2448 



Command Path 
Proposed Method 
Resolved Method 



546.00 
546.00 
545.52 



-84.866 
-84.863 
-68.216 



-7.1232 
-7.1924 



128.0020 
127.9635 



92.1837 
92.4919 



Command Path 
Proposed Method 
Resolved Method 



546.00 
546.00 
545.73 



91.514 
91.514 
92.947 



-17.0753 127.4846 91.4484 
-17.0519 127.3890 91.7938 



Command Path 
Proposed Method 
Resolved Method 



446.00 
446.00 
445.97 



91.514 
91.514 
93.167 



-25.5116 134.4894 100.8165 
-25.7427 134.4867 100.7127 
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Table 2: The Repeatability Test With The Two Methods 



X(mm) Y(mm) 0i(deg) 2 (deg) 3 (deg) 






Command Path 


446.00 


91.514 








Proposed Method 


446.00 


91.514 


-25.5116 


134.4894 


100.8165 


Resolved Method 


445.89 


93.140 


-25.7472 


134.4929 


100.7206 


Command Path 


446.00 


-84.866 








Proposed Method 


446.00 


-84.866 


-13.4927 


135.1801 


101.6627 


Resolved Method 


445.63 


-66.244 


-14.0476 


135.3249 


101.2557 


Command Path 


446.00 


91.514 








Proposed Method 


446.00 


91.514 


-25.5116 


134.4894 


100.8165 


Resolved Method 


445.60 


92.912 


-25.4178 


134.3821 


101.2799 


Command Path 


446.00 


-84.866 








Proposed Method 


446.00 


-84.866 


-13.4927 


135.1801 


101.6627 


Resolved Method 


: 445.57 


-66.184 


-14.0526 


135.3293 


101.2610 
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Table 3: The Comparison Of Solutions: Proposed Method Vs. 
solved Method With dx=0 



Re- 



X(mm) Y(mm) 0i(deg) 2 (deg) 3 (deg) 



Command Path 


446.00 


91.514 








Proposed Method 


446.00 


91.514 


-25.5116 


134.4894 


100.8165 


Resolved Method 


446.00 


91.514 


-25.5115 


134.4894 


100.8164 


Command Path 


446.00 


-84.866 








Proposed Method 


446.00 


-84.866 


-13.4927 


135.1801 


101.6627 


Resolved Method 


446.00 


-84.868 


-13.4927 


135.1801 


101.6626 


Command Path 


546.00 


-84.866 








Proposed Method 


546.00 


-84.863 


-7.1232 


128.0020 


92.1837 


Resolved Method 


546.00 


-84.863 


-7.1232 


128.0020 


92.1837 


Command Path 


546.00 


91.514 








Proposed Method 


546.00 


91.514 


-17.0753 


127.4846 


91.4484 


Resolved Method 


546.00 


91.514 


-17.0752 


127.4846 


91.4484 
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5.2 Discussions 

From the results of simulations, we may evaluate the proposed method 
in terms of accuracy and repeatability by comparing it with the resolved 
motion method. We can also derive some useful ideas from the relationship 
between the two methods. 

5.2.1 Accuracy 

As shown in Table 1 and Figure 3, the proposed method gives joint vari- 
ables which exactly correspond to the commanded x and y, minimizing the 
criteria function to avoid singularities. Clearly, we see that the accuracy in 
the workspace achieved with the proposed method is better than that with 
the resolved motion method. 

Therefore, the proposed method provides a useful mean for an accurate 
position control of the end-effector, when the manipulator is kinematically 
redundant. 

5.2.2 Repeatability 

Table 2 and Figure 2 show that the repeatability is not preserved with the 
resolved motion method because of the two factors mentioned in Section 3: 
the initial joint variables which are far from optimal joint values (Figure 
2) and the direction — clockwise or counterclockwise — of the path to be 
traced (Table 2). 

The lack of repeatablility can be a considerable drawback in robot ma- 
nipulators which perform cyclic tasks, because, as the end effector traces 
the cyclic path, joint variables evolve into states which cannot be predicted 
in advance. 

On the other hand, it is obvious that the proposed method preserves 
the repeatability regardless of direction. In other words, the method allows 
a fixed transformation from workspace to joint space. The property of 
fixed transformation is useful not only for the prediction of joint variables, 
but also for the precomputation of position dependent terms such as the 
Jacobian matrix and the inertia matrix. [Raibert and Horn, 1978] 
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5.2.3 Relationship between the Two Methods 

The result in Table 3 shows a nearly perfect agreement of both solutions, 
verifying that Eq.(7) in the proposed method is the equilibrium equation 
at which Eq.(ll) will finally arrive. 

Because of the relationship between the two methods, we may use them 
interchangeably as follows: 

• The exact equilibrium state can be determined either directly with 
the proposed method, or indirectly with the resolved motion method 
by setting dx = 0. The latter, however, would require more compu- 
tations than the former. 

• The incremental displacement dO, which Eq.(ll) in the resolved mo- 
tion method easily provides, can be also obtained by first differenti- 
ating Eq.(7a) to get the Jacobian matrix and then by inverting it. 

We can also make use of the relationship complementarily : The proposed 
method could be more effective if the initial guess for the method is provided 
by the resolved motion method. 

6 Conclusions 

In the paper, we have derived a general equation which resolves the redun- 
dancy in the kinematically redundant manipulator. This equation, together 
with the kinematic equations, constitutes a system of equations, the solu- 
tion of which generates accurate joint values which make the end effector 
trace the commanded path in the workspace, while minimizing the criteria 
function. 

We have compared the equation with two other methods. We have 
proved that the equation derived is a general equation that generates the 
extended Jacobian method. We have also shown that the proposed system 
of equations is an equilibrium equation toward which the resolved motion 
method converges. This point was proved and verified in the simulation 
results. The results of simulation also show that the proposed method gives 
better joint values than the resolved motion method in terms of accuracy 
and repeatability. 
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7 Appendix A. The Derivation of the Ex- 
tended Jacobian Method 

In this Appendix, we will prove that the extended Jacobian method is, in 
fact, a special case of Eq.(7). 

The additional equation to resolve the redundancy in the extended Ja- 
cobian method is given[Baillieul,1985] in Eqs.(8),(9), and (10) as 



where 
with 



G{6) =njh 
= 

n / = (A 1 ,A 2 ,...,A fl ) 



(8) 
(9) 



Ai = [-l) i+1 det( J 1 , J 2 , ..J'" 1 , J i+1 , .., J n ) (10) 

and where J k is the k-th column vector of the Jacobian matrix, J, derived 
from Eq.(l). When n = m + 1, our result, Eq.(7), is specified as 

G 2 {0) =[(J») T J m -\-l]h 
= 



(,41) 



where (J n ) T is the transpose of the ra-th column vector of the Jacobian 
matrix, J. J m -1 can be derived as 

j m -i = J_ Am (A2) 

where A m is the adjoint matrix of J m and D m is the determinant of J m . 
Thus A m is expressed as 

[Cofn Cof 21 ... Cof ml \ 
Cof u Cof 2 2 



■A-m — 



Cof m2 
Cof mm J 



(A3) 



\Cofi m Cof 2m 

where Co fa is the cofactor of j,y of the Jacobian matrix, J. From Eqs. (A l) , ( A2) , 
and (A3), we get 

( J»fj m -i = ±-\{r) T Al, [J n ) T Al, ...{J n ) T AZ\ {AA) 

J-Sm 



V***V 
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where A* m is the i-th. column vector of A m . Since 

( J n ) T A l m = j ln Cof n + tenCofn + .. + j mn Cof lm 

we get likewise 

{J n ) T Al = -A,- (A5) 

From the definition of A n , we get 

A n =det{J m T ) 

= det{J m ) (A6) 



Therefore, 



m\r T -i i\ — ( ^ ^ 2 



((J-fJm- 1 ,-!) = (-^-,-^,...,-1) (A7) 

Since J m is nonsingular — and thus A n is nonzero, we can multiply by it 
on both sides of Eq.(Al), resulting in Eq.(8). Thus we have proved that 
Eq.(7) is a general expression which yields the additional equation in the 
extended Jacobian method. 



8 Appendix B. The Relationship Between 
The Proposed Method And The Resolved 
Motion Method 

The matrix in Eq.(6a) is again, 

Z = [J n - m J m _1 : -In-m] (6a) 

Since the rank of any matrix is the dimension of its largest nonsingular 
submatrix, which is I n -m for Z, the rank of Z (and Z T , too) is n — m. In 
addition, since 



JZ — [J m : J n -:m J 
= 0, 



(Jm J (Jn-m )' 
~ -"-n-ni 



(Bl) 
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column vectors of Z T are a set of basis vectors which are orthogonal to J. 
Thus, row vectors of J, together with column vectors of Z T constitute the 
basis of n-dimensional vector space. 

Accordingly, any n-dimensional vector h can be represented as 

h = J T hi + Z r h 2 (S2) 

where hi and h 2 are arbitrary vectors of m and n — m dimensions, respec- 
tively. Premultiplying Eq.(B2) by J, we have 

Jh = JJ r hi 

Thus, 

hi = {33 T )~ 1 3h (B3) 

Similarly, if we multiply Eq.(B2) with Z and solve for h 2 , we get 

h 2 = (ZZ^Zh (£4) 

From Eq.(B2), Eq.(B3), and Eq.(B4), we obtain the following relationship: 

(I - J T (JJ T )- 1 J)h = Z r (ZZ r )- 1 Zh 

or, from Eq.(12), 

(I-J + J)h = Z T (ZZ r )" 1 Zh \BS) 

For a constant location of the end effector (no tip motion), when dx =0, 
Eq.(13), with Eq.(B5), becomes 

d0 = Z T {ZZ T )- l Zh (£6) 

If Zh = as in Eq.(7), then from Eq.(B6), S = 0, which means that 
joint variables reach an equilibrium state — or a stationary state — which 
is mostly the optimal configuraion for a given tip location. Conversely, if 
d6 = 0, we have Zh = 0; since the rank of Z r (ZZ T ) _1 in Eq.(B6) is n - m 
and Zh is an (n — m) -dimensional vector. 

Therefore, Zh = 0, Eq.(7), of the proposed method is the necessary 
and sufficient condition to be satisfied when Eq.(l3) of the resolved motion 
method reaches its equilibrium state. 
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